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Abstract 

Recently  there  has  Ivon  considerable  interest  in  ellicicnt  formulations  of  manipulator  dynamics,  mostly 
tine  to  the  desirability  of  real  lime  control  oi  analysis  of  physical  devices  using  modest  compnleis.  the 
mellieieney  of  the  classical  I  agrangian  formulation  is  well  know  n,  and  this  has  led  researchers  to  seek  al¬ 
ternative  methods.  Si  veral  authors  have  developed  a  highly  ellicicnt  fmmutaiion  of  manipulator  dynamics 
hase«l  on  the  Newton  filler  equations,  and  there  may  he  some  confusion  as  to  the  source  of  this  cflicicncy  ■ 
This  paper  shows  that  there  is  in  fact  no  fundamental  difference  in  computational  dliciency  between 
I  agrangian  and  Newton  Tiller  formulations.  The  dliciency  of  the  above-mentioned  Ncwton-Tulcr  tor- 
in  ulation  is  due  to  two  factors:  the  recursive  structure  of  the  computation  and  die  representation  chosen 
for  the  rotational  dynamics.  Moth  of  these  factors  can  be  achieved  in  the  I  .agrangian  formulation,  resulting 
in  an  algorithm  identical  to  the  Ncwton-Tulcr  formulation.  Recursive  I  agrangian  dynamics  has  been  dis¬ 
cussed  previously  h>  I  lollcrhach.  This  paper  takes  the  final  step  by  comparing  in  detail  the  representations 
that  have  been  used  for  rotational  dynamics  and  showing  that  with  a  proper  choice  of  representation  the 
I  agrangian  formulation  is  indeed  equivalent  to  the  Ncwton-Tuler  formulation. 
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1.  Background 


Manipulator  dynamics  concerns  the  relationship  between  the  motion  of  a  mechanical  kinematic  chain  of 
linkages  and  the  forces  applied  by  its  actuators,  for  some  problems,  such  as  simulation,  the  forces  are 
known  and  it  is  desired  to  compute  the  resulting  motion.  In  other  cases,  such  as  the  important  area  of 
real-time  control,  the  desired  motion  is  known  and  the  forces  necessary  to  achieve  that  motion  must  be 
computed.  In  either  case,  for  a  given  model  of  a  kinematic  chain  in  exact  solution  can  be  found,  within 
the  framework  of  Newtonian  mechanics,  t  he  former  case  redoes  to  a  system  of  non-linear  second  order 
differential  equations,  which  can  be  solved  immeiically.  The  latter  ease  is  easier  -  the  required  forces  can 
he  expressed  directly  in  terms  of  the  known  position,  velocity  and  acceleration  of  the  chain. 

In  this  paper  we  restrict  the  discussion  to  open-loop  kinematic  chains,  composed  of  rigid  links  con¬ 
nected  by  joints  that  allow  relative  motion  of  the  links.  We  assume  that  each  joint  has  only  one  degree 
of  freedom,  either  rotational  or  translational.  Multiple  rotational  degrees  of  freedom  can  be  modelled  by 
links  of  zero  mass  and  length. 


1.1  Lagrangian  Generalized  Coordinates 

In  Newton's  original  formulation  of  mechanics,  the  relationship  between  forces  tiding  on  bodies  and 
the  resulting  accelerations  is  described  using  cartesian  coordinate  systems.  There  arc  other,  equivalent 
ways  to  describe  the  dynamics  of  a  system  of  bodic  .  One  such  method  was  invented  by  l^grangc,  using 
what  arc  known  .is  generalized  coordinates.  Generalized  coordinates  arc  any  convenient  set  of  variables 
that  completely  define  the  position  of  a  system  of  bodies.  The  I  agrangc  equation 
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describes  the  relationship  between  the  corresponding  generalized  forces  acting  on  die  bodies  and  the 
kinetic  and  potential  energy  of  the  system.  Here  q,  is  a  gencrali/ed  coordinate,  r,  is  the  corresponding 
generalized  force,  and  the  dot  indicates  dilTcrentialion  with  respect  to  time.  L  is  the  I  agrangian  -the 
difference  between  the  total  kinetic  energy  and  the  total  potential  energy  of  the  system:  L  --  K  —  P. 

While  the  I  .(grange  equation  must  yield  the  same  numerical  results  as  direct  application  of  Newton’s 
laws,  cither  approach  may  be  more  convenient  than  the  other  in  a  given  situation,  or  may  provide  greater 
insight  into  the  physics  of  the  problem. 

1.2  The  Uicker/Kahn  Formulation 

A  kinematic  chain  has  a  natural  set  of  coordinates  that  completely  specify  its  position— ihc  joint 
variables  </,  (angles  for  rotational  joints  and  distances  Ibr  sliding  joints).  The  q,  satisfy  the  'equiremenls 
for  gencrali/ed  coordinates,  f  urthermore,  they  can  be  measured  direct!)  by  the  manipulator  and  the 
cot  responding  generalized  forces  (torques  for  rotational  joints  and  ordinal)  force  for  sliding  joints)  arc 
jovt  what  can  be  controlled.  It  is  not  surprising,  then,  that  the  pioneering  work  of  lacker  (I  |  and  Kahn  |2) 
on  the  dynamics  of  mechanical  linkages  made  use  of  the  I  agrangian  method. 

f  rom  the  standpoint  of  the  present  discussion,  the  important  feature  of  the  work  of  Uickcr  and 
Kahn  is  their  use  of  4  X  4  rolation/translalion  malricies  W,  to  represent  the  position  and  motion  of  the 
kinematic  chain.  A  coordinate  system  is  attached  to  and  moves  with  each  link.  The  matrix  W,  transforms 
the  components  of  a  vector  with  respect  to  link  t  coordinates  to  its  components  with  respect  to  a  fixed 
(inertial)  coordinate  system.  The  position  and  motion  of  the  chain  is  described  by  the  W,  s  and  their  time 
dc:  ivatives,  which  are  in  turn  functions  of  the  q,'  s  and  their  time  derivatives. 

O'v.c  the  kinetic  and  potential  energy  of  the  chain  is  expressed  in  terms  of  the  IV,  s  and  their  deriva¬ 
tives.  it  is  a  straightforward  matter  to  apply  the  l.agrungc  equation  and  find  the  gencrali/ed  forces.  Ibe 
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where  t,  is  die  generalized  force  applied  to  the  tih  joint,  Jj  is  the  I  x  i  inertia  matrix  of  the  jih  link  in 
ih.it  link's  coordinates,  and  tr  is  the  trace  operation.  Hie  gravity  term  is  omitted  here  because  it  is  not 
important  for  this  paper,  although  in  general  it  must  of  course  be  included. 

It  has  been  observed  by  many  authors  that  evaluating  (1.2)  directly  as  written  requires  time  propor¬ 
tional  to  the  fourth  power  of  the  number  of  links.  I  lollcrbach  |.l|  has  determined  that  for  6  links  well  </.cr 
lot) DIM)  .kUIs  and  multiplies  would  be  needed  to  compute  all  oi  the  r4’s,  and  I  nh  el  ul.  [4|  report  tli.it 
a  I  oi  trail  program  running  on  a  1*1)1*- 1 1/45  look  nearly  8  seconds  to  compute  them.  Since  a  real  time 
control  system  would  have  to  repeal  this  calculation  at  a  rate  on  die  order  of  60  II/,  until  recently  it  had 
been  believed  that  a  manipulator  could  not  be  controlled  by  direct  real-time  calculation  of  the  actuator 
forces,  without  introducing  approximations  or  using  lookup  tables. 

The  inefficiency  of  the  original  Uickcr/Kahn  formulation,  as  well  as  other  reasons,  have  led  research¬ 
ers  to  look  for  alternative  formulations  of  manipulator  dynamics.  Ilic  most  successful  of  these  has  been 
the  Ncwton-l  uler  approach. 


1.3  The  Newton  Euler  Approach 

In  order  to  apply  Newton’s  laws  to  objects  which  are  not  point  musses,  we  consider  such  objects  U> 
be  composed  of  a  large  number  of  point  masses  bound  together  by  effectively  infinite  internal  forces.  The 
laws  governing  these  so-called  "rigid  bodies"  may  be  derived  from  Newtonian  mechanics  (5).  'ITic  key 
feature  is  dial  the  description  of  motion  is  broken  up  into  two  independent  components— linear  motion 
of  the  center  of  mass  (or  other  suitable  point)  and  rotation  of  the  body  about  that  point.  Ilic  total  vector 
force  acting  on  the  body  is  related  to  the  acceleration  of  die  center  of  mass  by  Newton’s  second  law: 
£  —  mil.  The  total  vector  moment  (torque)  about  die  center  of  mass  is  related  to  the  angular  velocity  and 
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angular  accclcraliun  of  the  hotly  by  luilcr's  equation 

N  =  jT  u>  w  X  (/  •(#»)• 


(1.3) 


The  I  tiler  equation  follows  directly  from  the  laws  of  rotating  reference  frames  and  the  following 
definitions: 

ui  angular  velocity 

/  inertia  tensor 

L  —  /  u)  angular  momcnluin 

..  dL 

N  =  moment  (torque). 

at 

These  definitions  arc  analogous  to  those  found  in  the  case  of  linear  motion,  except  that  inertia  is  a  second 
rank  tensor  instead  of  a  scalar,  since  angular  momentum  is  not  in  general  parallel  to  angular  velocity.  If  we 
use  d*l<ll  to  indicate  differentiation  with  respect  to  the  rotating  reference  frame,  we  then  have: 


dL 


dt 


To  apply  the  Newton  liulei  equations  to  a  kinematic  chain,  the  following  procedure  may  be  used. 

1.  The  base  of  the  chain  is  either  fixed  or  its  motion  is  known.  Starting  from  the  base  and  working 
outwards,  and  using  the  known  geometry  of  tire  chain,  o,.  w„  and  u of  link  i  may  be  found  in 
terms  of  the  qJt  qj,  and  ijj  of  the  proceeding  joints. 

2.  The  total  vector  force  F,  and  the  total  vector  moment  N ,  acting  on  each  link  may  now  be 
determined  using  the  Ncwton/lutlcr equations. 

3.  The  total  force  computed  in  step  2  is  the  vector  sum  of  the  forces  exerted  on  the  link  by  its 
neighbors  at  the  joints,  and  the  force  of  gravity.  The  total  moment  is  the  vector  sum  of  the  pure 
moments  exerted  on  the  link  by  its  neighbors,  and  the  moments  generated  by  the  forces  exerted 
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hy  ils  neighbors.  Ilius  if  the  force  and  moment  acting  at  one  end  of  a  link  are  known,  we  can 
use  the  totals  from  step  2  and  the  known  force  of  gravity  to  solve  for  the  force  and  moment 
acting  ;it  the  other  end.  These  are  equal  and  opposite  to  the  force  and  moment  exerted  hy  the 
given  link  on  its  neighbor,  by  Newton's  third  law.  Ilius,  if  the  force  and  moment  exerted  by  the 
environment  on  the  terminal  link  (c.g.  the  hand)  arc  known,  we  can  proceed  down  the  chain  to 
the  base  and  determine  the  force  and  moment  acting  at  each  joint. 

4.  Tor  rotational  joints,  the  vector  moment  determined  in  step  3  is  projected  along  the  axis  of 
rotation  to  yield  the  joint  torque.  Tor  sliding  joints,  the  vector  force  from  step  3  is  projected 
along  the  sliding  axis  to  yield  the  joint  force.  The  other  components  of  (he  force  and  moment 
are  generated  by  the  structure  and  bearings  of  the  device. 

It  is  clear  that  many  details  must  be  filled  in  helot e  the  above  procedure  can  actually  be  applied  to  a 
kinematic  chain.  We  must  have  conventions  for  defining  the  geometry  of  the  chain  and  specifying  how  the 
joint  variables  are  to  be  measured,  and  coordinate  systems  that  allow  the  vector  and  tensor  quantities  to 
be  specified.  The  transformation  required  by  step  I  must  be  worked  out.  and  the  operations  specified  by 
the  other  steps  must  he  w  ritten  down  in  detail.  The  efficiency  of  the  resulting  computation  will  depend  on 
how  these  issues  arc  resolved. 

Recently  a  number  of  authors  have  been  interested  in  the  Ncwton-Tuler  approach,  partly  due  to 
perceived  problems  with  the  I  agrangian  formulation,  as  mentioned  above.  Stepanenko  and  Vukobratovic 
|h|  worked  out  the  details  in  connection  w  ith  work  on  understanding  the  dynamics  of  human  limbs.  One 
of  their  main  goals  was  to  develop  a  computer  program  that  could  perform  the  tedious  mathematical 
manipulations  necessary  to  set  up  the  equations  of  motion  from  a  dc  eriplion  of  the  kinematic  chain. 
They  rejected  the  I  agrangc  equation  because  of  the  differentiations  it  requires— there  arc  severe  problems 
associated  with  numerical  differentiation,  as  they  pointed  out.  Iliesc  problems  can  be  avoided,  however, 
by  deriving  the  differentia!  equation  of  motion  for  an  arbitrary  kinematic  chain,  as  is  done  in  section  3 
for  the  open-loop  class.  Numerical  values  for  a  specific  device  arc  then  substituted,  but  at  this  point  all  of 
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the  necessary  dilfercntialions  have  been  done  symbolically.  The  general  solution  can  readily  be  found  by 
hand,  and  only  needs  to  he  done  once. 

Stepanenko  and  Vukobratovic  were  not  concerned  with  the  efficiency  of  the  computation.  Their 
formulation  was  revised  by  Orin  cl  al.  [7]  in  connection  with  the  control  of  robot  legs.  'They  improved 
upon  the  efficiency  of  Stepanenko  and  Vukobratov  ic  by  referring  the  forces  and  moments  to  coordinate 
systems  attached  to  the  links  instead  of  fixed  coordinates.  Nicy  also  noticed  that  the  sequential  nature 
of  the  compulation  (iterating  from  the  base  to  the  tip  to  determine  the  motion  of  the  chain,  and  (hen 
from  the  tip  lo  the  base  to  determine  the  forces,  as  described  above)  seemed  to  reduce  the  computation 
time  and  storage  requirements.  They  speculated  that  such  a  recursive  procedure  might  he  more  efficient 
in  general,  but  did  not  draw  any  conclusions.  Armstrong  |8|  and  I  .uh  el  al.  |4|  paid  close  attention  lo  com¬ 
putational  efficiency  and  confirmed  these  suspicions.  They  pointed  out  that  the  Newton  Tiller  formulation 
leads  to  an  algorithm  where  the  computation  time  grows  linearly  with  the  number  of  links,  as  opposed 
to  the  quartic  behaviour  of  the  original  lagrangian  formulation.  They  further  improved  the  efficiency  by 
referring  the  linear  and  angular  velocities  and  accelerations,  as  well  as  the  forces  and  moments,  lo  link 
coordinates.  In  addition,  the  need  for  efficiency  produced  a  formulation  which  is  simpler  in  many  ways. 
Tor  example,  the  three  coordinate  systems  attached  to  each  link  by  Stepanenko  and  Vukobratovic  were 
replaced  by  one. 

1.4  Recursive  Lagrangian  Dynamics 

llollcrbach  (3)  realized  that  the  recursive  nature  of  the  Newton -luder  formulation  that  made  it  so 
efficient  could  be  achieved  with  the  lagrangian  formulation  as  well.  Starting  with  the  original  results  of 
Uickcr  and  Kahn,  lie  developed  forward  and  backward  recurrence  relations  for  the  terms  in  (1.2)  that  al¬ 
low  the  generalized  forces  to  be  computed  in  linear  time.  The  result  for  a  6-link  manipulator  still  required 
about  5  times  the  number  of  adds  and  multiplies  ns  the  I  uh  formulation,  but  this  is  about  15  times  better 
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llullcrbach  also  realized  that  the  use  of  4  X  4  rotation/translation  matrieies  to  represent  the  position 
and  motion  of  the  chain  led  to  inefficiencies  in  the  calculation,  lie  reformulated  the  lagrangian  dynamics 
in  terms  of  pure  rotation  matrieies  to  specify  the  orientation  of  the  links,  and  displacement  vectors  to 
specify  their  position.  This  reformulation  resulted  in  an  additional  factor  of  2  savings  in  adds  and  mul¬ 
tiplies.  bringing  the  l  agrangian  formulation  to  within  roughly  a  factor  of  2^  of  l  ull’s  NewlonTulcr 
formulation. 


1.5  The  Importance  of  the  Representation  of  Angular  Velocity 

llullcrbach  used  a  rotation  matrix  IV,  to  specify  the  orientation  of  link  t  of  the  kinematic  chain.  IVj 
transforms  die  components  of  a  vector  with  respect  to  a  coordinate  system  fixed  in  link  t  to  its  components 
with  respect  to  a  fixed  (inertial)  coordinate  system.  The  angular  motion  of  link  i  is  represented  by  the  time 
derivatives  of  W,:  W ,  and  IV,. 

Although  IV,,  IV,,  and  IV,  each  have  nine  components,  orientation  has  only  three  degrees  of 
freedom  and  thus  only  three  of  the  components  are  independent.  An  equivalent  representation  for  the 
angular  motion  of  a  link  is  the  angular  velocity  vector  w,  and  the  angular  acceleration  vector  u>,,  which 
have  been  used  in  all  of  the  NewlonTulcr  formulations  reported  here,  and  which  contain  no  redundant 
information.  Unfortunately,  there  in  no  ‘‘orientation  vector”  corresponding  to  W,;  die  Hitler  angles  or 
equivalent  may  be  used  instead,  although  we  will  not  need  to  do  so  here. 

In  the  next  section  we  explore  in  detail  the  relationship  between  w  and  IV,  and  die  resulting  descrip¬ 
tions  of  rotational  dynamics.  In  die  following  section  we  show  that  a  I  agrangian  formulation  based  on 
w  instead  of  IV  leads  to  exactly  the  same  computation  as  die  NewlonTulcr  formulation.  This  result  is 
hardly  surprising,  since  both  methods  must  give  the  same  numerical  solution,  and  we  are  now  starting 
with  exactly  the  same  quantities.  The  significance  of  this  result  is  not  just  (hat  it  doesn't  matter  which 
formulation  one  uses.  Rather,  it  shows  what  the  real  issues  are  if  one  is  interested  in  efficiency:  structure  of 
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the  computation  and  choice  of  representation. 


2.  Comparison  of  Rotational  Dynamics  with  w  and  W 


It  w.is  pointed  util  aho\e  dial  the  angular  motion  of  a  rigid  body  could  be  described  equally  well  by  either 
the  angular  velocity  vector  to  or  the  derivative  of  a  rotation  matrix.  W.  Obv  iously,  scalar  quantities  such  as 
kinetic  energy  must  be  independent  of  the  representation  chosen,  but  higher  raitk  tensor  quantities  need 
not  he,  and  expressions  for  any  quantity  will  be  different  in  form.  ITirthermorc,  neither  representation  is 
clearly  better  in  all  cases.  Use  ofu)  may  yield  a  more  efficient  computation,  but  it  has  the  disadvantage  dial 
there  is  no  “angular  position  vector"  that  it  is  the  derivative  of.  '  hcrelbre.  it  is  interesting  and  useful  to 
compare  the  description  of  rotational  dynamics  that  results  from  different  choices  of  representation,  and 
to  develop  formulas  that  allow  one  to  switch  between  representations.  That  is  the  main  purpose  of  this 
section,  although  in  making  this  comparison  we  w  ill  also  get  expansions  for  rotational  inertia  and  kinetic 
energy  which  are  needed  in  the  next  section. 

2.1  vv 

Wc  start  by  defining  W  more  formally  and  introducing  some  conventions  that  are  needed  below. 
We  assume  that  the  reader  is  familiar  with  the  properties  of  the  angular  velocity  vector  w  and  rotating 
reference  frames,  which  have  been  discussed  in  many  texts  (see.  for  example,  |5J). 

I  el  {f|  ,ci,  c.i}  be  any  fixed  (inertial)  orthonormal  basis,  and  let  e',}  be  any  orthouormal  basis 

attached  to  a  rotating  rigid  body.  We  will  always  use  primes  to  indicate  rotating  basis  vectors  or  the 
components  of  a  vector  w  ith  respect  to  such  a  basis.  Thus,  if  w  is  any  vector  wc  have: 


t  » 


U 
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I'rom  now  on  we  will  drop  the  summation  sign  and  use  the  I'instcin  summation  convention,  that  is, 
indices  that  appear  twice  in  any  term  imply  a  summation  of  that  term  overall  values  of  the  indices  (i.c. 
{ i ,  '2,  :*>). 


(2.1) 

Note  also  that  since  (he  inverse  of  W  is  its  transpose,  wc  have: 

W,k\V'kj  --  WlkWjk  --  dij,  (2.2) 

wheieiVj  ate  the  components  ol  the  identity  tensor  A. 

?.?  The  Cross  Product  Operation 

Wc  must  now  briefly  discuss  the  cross-product  operation,  which  is  indispensible  when  dealing  with 
rotation  in  three  dimensions,  and  which  must  be  used  unambiguously  with  second  rank  tensors  as  well  as 
vectors.  We  assume  that  the  standard  geometric  definition  of  the  cross  product  of  two  vectors  is  known  to 
the  reader. 

The  cross  product  may  he  v  iewed  as  a  function  of  two  vectors  that  produces  a  third  vector: 

a  X  b~c  —  l’[a,b). 

\h-.i  natively,  we  may  \  iew  the  cross  product  as  a  function  of  three  vectors  that  produces  a  scalar,  the  so* 

aXbc~a~  P{n,b,  c). 


I  King  the  ahovecoiiveniiuns  we  can  write: 


/  /V 

”  v/j 

V  •  e,  ~  et  •  tfjVj 

V ,  = 

dWtJ 

W  —  -  - 

11  At  ■ 


called  scalar  triple  product: 


William  M  Silver 


13 


(  ompanson  of  lintttional  Dynamics  will)  ^  and  II 


I  lie  function  P  is: 

•  I  .incur  in  n,  6,  and  c. 

•  Independent  of  the  choice  of  basis  vectors  (since  it  is  defined  geometrically). 

Therefore,  P  is  a  rank  three  tensor1. 

To  find  the  components  of  P  according  to  some  light-handed  basis  {ei ,  e^, «.»}.  we  simply  apply  llic 
function  to  the  basis  vectors: 

=  I’fc.ejk) 

A  A  A 

=  c,X  e}  ■  ek 

I.  if  ijk  is  an  even  permutation  of  123, 

-  <  I,  if  ijk  is  an  odd  permutation  of  123, 

0.  otherwise. 

I  'rom  this  it  can  be  seen  dial  P  is  totally  anti  symmetric— swapping  any  two  indices  changes  die  sign  (but 
rotating  the  indices  has  no  effect).  To  illustrate  how  P  is  used,  here  arc  die  formulas  for  die  cross-product 
of  two  vectors,  and  the  scalar  triple  product,  in  coordinates: 

[ft  X  6]  i  —  Pi  jk&jbk  ft  '  i*  X  C  =  Pi  jk&ibjC)c. 

There  arc  two  very  useful  identities  associated  with  die  components  of  P: 

PijkPiji  =  2 SM,  (23) 

and 

PijkPtfm  —  Gjmfikl' 

'  technically,  a  psrudoiensor,  since  it  requires  consistent  use  of  right-  or  IcA-handcd  coordinate  systems,  but  not  both, 


(M 


William  M  Silver 


14 


(  onip.iriMHi  <4  KocnitHiiil  Duiamics  with  u >  and  It 


2.3  The  Relationship  Between  <m  and  VV 

Wc  can  now  find  llic  explicit  relationship  between  u>  and  VV.  That  relationship  will  be  seen  to  be 
position  (i.c.  orientation)  dependent,  and  the  position  will  always  be  represented  by  the  rotation  matrix 
W. 

l  et  v  be  any  vector  rotating  with  angular  velocity  u>.  We  can  derive  the  components  of  v  in  the 
following  two  ways: 

I )  v  ~u  X  v  2)  v,-~  Wijv'j 

i>,  kVi  Vt—WijV '■ 

Equating  the  two  gives: 

W.jv'j  -  P.t/ufc.v,  —  P.ktUkWijV1-. 

Since  this  must  hold  for  any  v.  it  is  clear  that 

W,j  =  PMukWtj  (2.5) 

(or  in  vector  notation,  VV  —  w  x  IV).  The  inverse  relation  may  be  found  from  this  and  equations  (2.2) 
and  (2.3)  as  follows: 

W,j  --  l\uujkWtj 

~  Pikl^k^hn  =  Pikin^k 

Pinm  ^inj  f  ikmP i IntiM-  ^^kn^k  ==  2W||. 

Making  an  appropriate  change  of  tliininiy  indices,  weget 

=  }  P.jkWjW",  (2.6) 

to  which  there  is  no  corresponding  vector  notation  known  to  the  author. 

2.4  Rotational  Inertia  and  Kinetic  Energy 

This  section  has  three  purposes:  it  gives  one  example  of  how  a  dynamic  quantity  (rotational  kinetic 
energy)  can  he  expressed  in  terms  of  either  m  or  VV,  it  provides  one  way  of  delining  the  inertia  tensor  (the 
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definition  will  depend  on  whether  ur  or  IV  is  used),  and  it  provides  (he  expression  for  rotational  kinetic 
energy  that  is  needed  for  the  I  agrangian  formulation  of  the  next  section. 

I  el  r  he  .1  vector  from  the  center  of  mass  of  a  rigid  body  to  a  small  volume  element  of  mass  dm.  The 
velocity  and  kinetic  energy  of  the  volume  element  {due  to  rotation  of  the  body  )can  be  written  as: 

v  —  r 

dl<  =  Jo  vdm. 


We  will  express  dK  in  terms  of  both  W  and  u)  and  integrate  over  the  body  to  get  die  total  rotational 
kinetic  energy,  flic  definitions  of  the  inertia  tensor  will  fall  out  of  the  derivation.  Components  of  vectors 
are  with  respect  to  any  right-handed  orthonormal  basis,  primed  for  rotating  and  tinprimcd  for  fixed,  as 
above,  f  irst,  using  IV: 


r,  =  Wifi 

v,  - 

dK  --  HW./jWikr&m 


K  =  J  WtJW,k.Jvr'/kdm 

J'jk  =  l/Adm 

(2.7) 

=  \tr(WJ'WT). 

(2.8) 

The  last  expression  is  in  matrix  form  for  the  benifil  of  readers  who  arc  more  familiar  with  that  notation. 


Now  wc  repeat  the  derivation,  using  w  instead: 
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w  -  w  x  r 

(IK  —  )(w  X  r)  (w  x  r)dm 

)  ((u>  u;)(r  r)  —  (u;  r)(w  r)\dm 
—  ^  [u»,w1r2  -  Wjr.WjrJdm 


— 

)(u 

= 

Jw.u )j{r26,j  —  r,rj)dm 

K  = 

iui.w,  y  (r2^  ~  rtTj)dm 

l.j  - 

fv(r*6‘j  -  rtrMm 

(29) 

K 

-  \u>  1  u). 

(2  10) 

I  loin  equations  (2.7)  .nuJ  (.V))  the  iclalioitship  hoi  ween  the  two  inertia  tensors  can  he  seen: 

/  lr(J)b-J,  (2  11) 

Nmc  th.it  since  /  .ind ./  have  been  defined  .ibmc  by  their  components,  they  have  not  actually  been  shown 
to  he  tensor.  I  he  proof  is  simple  and  can  be  supplied  by  die  reader. 

f  rom  equations  (2.8)  and  (2.1(1),  and  a  definition  of  a  generalized  coordinate  q,  the  rotational  con¬ 
tribution  to  the  corresponding  generalized  force  can  be  found  from  die  I  agrangc  equation.  I  bis  was 
done  h>  llollethnch  |.l)  lor  W,  and  is  done  in  the  next  section  forw.  We  summarize  the  results  here  for 
comparison: 


angular 

velocity 

u; 

* 

W 

kinetic 

energy 

Jw  l 

\lr(WJWr) 

generalized 

force 

(w  /  +  w  X  (/.  w)j  ^ 

Atj* 1 

While  these  expressions  have  been  derived  independently,  their  equality  can  be  verified  by  direct  substitu¬ 
tion  using  equations (2.4).  (2.5),  (2.6),  and  (2.11). 


3.  Lagrongian  Dynamics  Using  u>  Instead  of  W 


In  iliis  section  vcc  give  the  details  »<f  the  I  ugrangiun  formulation  based  on  the  angular  velocity  sector  ut. 
I  he  generalized  Ibices  are  derived  Cor  any  open  loop  kinematic  chain,  and  the  results  are  interpreted  and 
compared  to  the  Newton-I  tiler  Ibiimilation  of  I  .uli  |4|. 

One  feature  that  distinguishes  the  present  formulation  from  previous  ones  is  Unit  expressions  for  the 
generalized  forces  are  derived  without  defining  a  single  coordinate  system.  All  quantities  arc  expressed  in 
terms  of  geometric  objects  (tensors)  and  geometric  operations  (vector  addition,  dot  and  cross  product).  It 
is  only  at  the  end.  when  a  computation  must  he  derived  from  these  expressions,  that  coordinate  systems 
must  be  defined,  so  that  the  various  quantities  can  he  measured  and  reptescnlcd  in  a  computer  program. 
At  this  point,  expressions  may  he  evaluated  in  any  convenient  light-handed  orthonormal  coordinate  sys¬ 
tem.  provided  that  (Ins  is  done  so  in  .1  consistent  maimer.  In  practice.  Ihe  method  presented  by  I  nli  |4|  is 
probably  most  cllicicnt. 


3.1  The  Derivation  of  the  Generalized  Forces 

In  this  section  we  write  down  die  total  kinetic  energy  of  a  kinematic  chain  and  apply  the  l  agrangc 
equation  to  derive  the  generalized  forces.  The  potential  energy  term  due  to  gravity  is  »>mittcd  here  as 
mentioned  in  section  1.2,  although  this  and  other  minor  details  arc  taken  care  of  below. 

ITic  total  kinetic  energy  of  a  rigid  body  is  the  sum  of  the  energy  due  to  the  motion  of  the  center  of 
mass  and  the  energy  due  to  rotation  about  the  center  of  mass  (5): 


K  Jm(y)1  -f 
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Substituting  (3.4)-(3.7)  into  (3.3)  gives: 


d 

dt\ 


( ^  \  XT"'  ,  <9t>i  ,  .  ,  ,  ,  Ouii 

U J ?  n  ■  + m,?'  ■  * + ' *  • <%■ + *  >■  ■  as  J 


(3.8) 


Now  lor  the  lin.il  term  in  the  I  agrangc  equation: 

E 


OK 


Ov,  fOa,  ,  01, 

™.v,  ..  hw.  /r  Jw,  •  .,  u», 

•*b  <*lj  (K 


(3.9) 


I  Ins  is  very  similar  to  (3.2).  except  for  the  appcarcncc  of  a  lenn  due  to  ihc  position  dependence  of  the 
inc  ,i.u  tcnsoi  k  is  shown  in  Appendix  A  that: 


i  n  »  fyi 

iw. =  tsh) 


(3.10) 


I'uiung  it  all  together: 


d  (OK  \  OK 

T>  J  dq} 

X-*  ( 

?( . -at, 


j  |ui,  I,  [  w,  X  (/,  w,)| 


<*l,) 


(III) 


3.2  Comparison  with  the  Newton-Euler  Formulation 

We  have  derived  the  generalized  forces  in  a  very  general  way.  without  unnecessary  details  like 
coordinate  systems,  link  and  joint  numbering  conventions,  and  other  conventions  needed  to  specify  the 
geometry  of  the  manipulator.  In  order  to  interpret  the  result  and  compare  it  to  the  Ncwton-Kulcr  formula¬ 
tion,  however,  it  is  finally  necessary  to  make  some  of  these  definitions.  Such  details  arc  not  the  point  of 
this  paper,  and  will  he  kept  to  a  minimum. 

The  links  of  the  manipulator  arc  niunlicrcd  consecutively  from  the  base  to  the  lip,  as  arc  ihc  joints 
that  connect  them.  The  base  is  considered  to  be  link  0,  while  the  terminal  link  is  numbered  link  ».  The 
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Figure  3.1.  l  ink  and  joint  numbering,  and  other  conveniions  for  open-loop  kinematic  chains. 

joints  arc  numbered  1  thru  n,  joint  i  connecting  link  1  to  the  base.  Unis  joint  i  connects  links  t  —  1  and 
i.  link  i.  is  hounded  by  joints  i  and  i  |  I,  as  shown  in  figure  3.1. 

If  joint  i  is  mlation.il.  the  joint  variable  q,  measures  (he  angle  of  rotation  from  some  (arbitrary  for  the 
present  discussion)  reference  point;  if  it  is  translational,  </;  measures  the  sliding  distance.  The  unit  vector 
z,  is  attached  to  joint  t  and  points  along  the  axis  of  rotation  lor  rotary  joints  or  along  the  sliding  axis  for 
sliding  joints.  Note  that  for  rotary  joints,  q,  must  be  measured  in  a  right-hand  sense  about  z,.  Finally,  let 
Pj  t  be  a  position  vector  that  points  from  anywhere  along  the  axis  of  joint  j  to  the  center  of  mass  of  link 
i.  (Note;  These  definitions  of  z,  and  p,,,  are  non-standard,  and  arc  clearly  loo  ambiguous  to  be  used  in 
pr.icticc.  They  are,  however,  all  that  is  needed  to  understand  equation  (3.11)). 

One  of  the  first  things  one  notices  when  looking  at  equation  (3.11)  is  that  it  contains  the  Newton- 
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Hulcr  expressions  for  die  total  vector  force  and  moment  acting  on  a  rigid  body.  In  fact  we  can  rewrite 
(3.1  l)as: 


(3.12) 


Thus  we  arc  very  interested  in  the  vectors  dvl(dq1  and  du>t/d(]j  that  the  force  F,  and  moment  iV,  arc 
projected  onto.  These  vectors  specify  the  dependence  of  the  linear  and  angular  velocity  of  link  i  on  the 
joint  velocity  of  joint  ;.  Tor  ;  >  i  there  is  no  such  dependence,  and  so  these  vectors  arc  0.  This  means 
that  the  summation  in  equation  (3.12)  can  he  taken  from  t  —  ;  to  i  —  n,  instead  of  over  all  t. 


For  j  <  t,  we  note  that  the  linear  and  angular  motion  of  link  i  may  be  written  as  the  vector  sum  of 
contributions  due  to  the  relative  motion  of  the  previous  links  at  the  joints: 


Si 


if  joint  j  is  rotational; 
if  joint;  is  translational. 


(3.13) 


Differentiating  gives: 


if  joint;  is  rotational; 
if  joint ;  is  translational. 

if  joint ;  is  rotational; 
if  joint;  is  translational. 


if  joint;  is  rotational; 
if  joint;  is  translational. 


(3.M) 


(3.15) 


(3.16) 


If  joint;  is  translational,  the  joint  force  can  now  be  written: 
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If  joint  j  is  rotary,  tlie  torque  is: 


n 

T>  =  V  £(p;,.  X  £.  +  #,)• 
i'=j 

Thus,  to  compute  the  generalized  forces  we  first  iterate  from  the  base  to  (lie  lip  to  compute  »>,,  w,-,  and  wt, 
ami  then  iterate  from  the  tip  to  Ihe  base  using  the  above  relations  in  compute  (he  forces.  Referring  to  |4|,  it 
can  be  seen  that  this  is  exactly  the  computation  specified  by  I  uh  that  was  derived  from  the  Newlon-Fuler 
approach. 

A  few  minor  points  still  need  to  be  cleared  up,  however,  First,  we  are  still  free  to  choose  a  coordinate 
system  or  systems  in  which  to  evaluate  these  expressions.  The  method  presented  in  [4]  is  probably  best, 
where  quantities  associated  with  a  given  link  (such  as  the  inertia  tensor)  are  expressed  in  a  coordinate 
system  attached  to  that  link,  and  then  arc  transformed  to  the  coordinates  of  the  previous  link  as  the 
iteration  proceeds. 

Second,  we  must  say  something  about  the  gravity  term  which  we  have  thus  far  ignored.  We  could 
include  it  in  (he  Lagrange  equation  in  the  standard  way,  as  a  position  dependent  potential  energy  term. 
Ibis  is  equivalent  to  ils  inr  fusion  in  the  Newton-Fuicr  formulation  as  described  in  step  .1  of  section  U. 
Perhaps  a  better  way  was  also  discussed  by  I  uh  instead  of  considering  the  base  as  fixed,  give  it  a  vector 
acceleration  equal  to  that  due  to  gravity.  Both  methods  will  give  the  same  numerical  result,  but  I .uh’s  is 
probably  more  efficient  since  the  effect  of  gravity  is  computed  only  once. 

Third  is  the  sliding  friction  forces  produced  in  the  joints  that  Lull  includes  in  his  equations.  These, 
however,  arc  simply  computed  based  on  the  joint  velocity  and  arc  added  directly  to  the  joint  generalized 
force.  This  clearly  can  be  done  no  matter  how  the  dynamics  arc  formulated. 

Finally,  the  Newton-Kulcr  dynamics  includes  the  solution  to  the  problem  of  the  statics  of  tlie 
manipulator,  that  is  the  effect  of  the  external  force  and  moment  acting  on  the  terminal  link.  ’This  can 
be  included  in  tlie  l.agrangian  formulation  by  supposing  an  additional  link  attached  to  the  terminal  link. 
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whose  motion  is  defined  so  ,is  to  produce  the  required  external  forces.  This  is  very  much  like  including 
gravity  hy  specifying  the  acceleration  of  the  base  rather  than  the  equivalent  forces. 


A.  Details  for  the  Lagrangian  Formulation 


In  this  Appendix  we  supply  die  details  that  were  omitted  from  the  demotion  of  the  generalized  forces 
presented  in  section  2.1. 


for  equation  (.1.4),  let  r,  he  a  position  rector  from  any  fixed  origin  to  the  center  of  mass  of  link  t,  so 


that  Vi  ~  ti- Then  we  have: 


dv,  dr,  d  Y'dr,  .  _  dr i 

dqj  dqj  dqj  ^  dqkqk  dqj 
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IVlaiK  for  ihe  I  a^iaiifian  I'oimulaiion 


I  or  equation  (3.10):  Following  a  procedure  similar  to  that  used  in  (A.  1)  above,  it  can  be  shown  that: 


Thus  we  have: 


SI,  Oli 
dqj  Sq/ 


ah  q 

~a~  ~  (‘ib  X  /f  Ll  X  U>i) 
oqj  dqj 

Si>i  .  .  dun 

=  ^  xX.-Xt  x 

dqj  ~  ~  c*7j 


Therefore, 


i  i  [&*>t  i  f,  A 

-  ^  ^  x J  ^  x  -- J  ■ «, 

=  I". '  tv  X  (/,  •  *,)  -  ife,  /.)  X  f ! !  ■ % 
dqj  '  -  dqj 

«  -  W.  x  (/,  •  <*,)  ■  -  .$<*  x  (/,•  •  *,•)  •  ^ 

oqj  Oqj 

ft  \ 

=■■  — w#  X  (/i-w,-)* 

OQj 


The  final  (and  trickiest)  proof  is  equation  (3.6): 


V<%;  «% 


d  ( dw 
dl 


We  will  need  equations  (3.14)  and  (3.16),  and  the  conventions  of  section  3.2  (see  figure  3.1),  except  that  for 
convenience  we  will  take  2*  to  be  0  if  joint  k  is  translational. 

First  note  that  if  joint  j  is  translational,  or  if  j  >  t,  w,  is  independent  of  both  qj  and  qj ,  so  that  both 
sides  of  the  equation  arc  identically  zero.  Now  for  j  <  t,  since  Zj  is  attached  to  joint  j  and  therefore  link 
j,  we  inay  write: 

,1  ( ,1.1  \  rfSv 

M2) 


d 

dl 


( (%j,\  dzj  A 

U;j 


lly  considering  the  rotation  of  a  vector  hy  some  angle  about  a  given  axis,  it  can  be  seen  that: 

=  *j  X  zit  {]  <  k). 


dqj 


(4.3) 
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Details  Tor  the  I  agrangian  l  ormulation 


Now  we  have  everything  we  need  for  the  proof.  Starting  with  (A.2), 


d  I  t%jj 
dlySfij 


u>j  X  zj 


(w,  -  Xj  x 

Ic  j  |  I 


u/,  X  Zj  +  Y]  «x5t 
fc=y+i 

A  V-" t  .  <9z* 

fc=0 


A  .  5  V— \  .  A 

w‘  X  +  A  2-1  qk*k 

aqj  k=.\ 

duoi  dun 
X  /  n  *• 
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